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ABSTRACT 


In airborne anti-submarine warfare there is a neec to 
more accurately determine the positions of soOnobuoys on the 
surface of the water. This report develops two algcritnms 
which employ extended Kalman filters to determine estimated 
position. The tearing from the aircraft to the sonobuoy is 
the primary measurement. Range infcrmation is not available. 
The first algorithm is a six-state filter which was reduced 
from the lé-state system developed ty the Orincon Corporation. 
Its states include relative position, relative velocity, and 
inertial misalignments. The seconc algoritnm includes two 
cascaded Kalman filters. The orimary two-state filter 
estimates sonobuoy vdosition. A secondary filter estimates 
drift from information obdtained from the wvrimary filter. 

Both algoritnmms successfully estimated sonotuoy position for 
Simulatea aircraft data. The effect of aircrafi-to-sonobucy 
range, the frequency of measurement, and changes in eltitude 


are also analyzed. 
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I. INTRODUCTION 


The P3 Orion is the U.S. Navy's primary long range 
anti-submarine warfare (ASW) aircraft. It is outfitted with 
equipment which allows it to search for, locate, and track 
submarines. The aircraft carries a Univac dizital ccmputer, 
the CP 981, which performs much of the navigational and 
taetiCdl plotting chores. Ihe primary sensor used by this 
and many other ASW aircraft is an airdropped listening 
device known as a sonobuoy. Tne Orion generally deploys 
several sonobuoys (4 to 22) in patterns which can ccver a 
thousand square miles of ocean while searching for the 
Submarine. Once contact has been made, these sonobuoys 
provide information which locates the submarine. The target 
can then te tracked (or attacked if required) until the 
Oricon’s missicn is complete. 

The sonobuoy is dropved from the aircraft at tne 
e@ographnical location designated py the aircrew. Once in 
the water the sonoduoy floats and deploys a hydrophone to 
depths varying from 58 to 58¢ feet. The information picked 
up is transmitted back to the aircraft where it is analyzed. 
This information can consist of the relative intensity of 
target noise, tearings and sometimes ranges to the target, 
a!1 Of Which are used to fix the current position of the 
sutmarine. In order to maintain close, accurate trackinzg and 


be able to launch an attack, the suomarine’s position must 


LO 





te accurate to within several hundred yards. ‘the 
information received from the sonobuoys has some error 
inherent in the nature of the measurements made ty the 
hydrophone. Sonobucy pesition error also contributes 
Sven ificantly to the submarine tracking inaccuracies. 

historically, the positions of the sonobuoys were 
determined and updated by mark-on-top s. This required the 
aircraft to nome on the transmitting sonotuoy until the buoy 
was cverflown. At that instant the aircraft’s position was 
entered into the on-board computer whicn slewed the buoy to 
tnis updeted positior. After nany of these updates the 
computer was able to develop a bias which was acvplieéd to the 
sonobuoy positions in the computer effectively allowing them 
to drift. The method had several disadvantases. “#rror in the 
updated position was at least as great as the aircraft 
altitude at the time of the ‘mark which could vary from 322 
to 2<%,0@06 feet. The eccureécy also cepended on the 
consistency of the several pilots who mignt be maxing the 
Mark—-On—-teps curing the flint, The updating was not 
continuous in that it was several minutes between 
consecutive marks on one buoy at best, and more likely Jd to 
6@ minutes. Not all buoys were even updated. frurthermore, 
tails method reculiréed tHe alrcrart to overrfly the sucmdrine 
many times in order to maxe the mark-or-tops. This should 
be avoided. 

The purpose of this thesis was to investizate some 


alternative methods for accurately fixing the positicn of 


ist 





sonobuoys. They should allow the aircraft to stand-off from 
the sonobucy field and still produce more accurate fixing 
than the nistorical method provided. The Naval Air 
Development Center (NADC) at Warminster, PA. had already 
partially developed such a system. This thesis was 
undertaken in support of their work but was conducted 
independertly. Their system, the Sonobuoy Reference System 
(SRS), was already installed on the aircraft and had the 
capability of measuring the relative bearing to any 
transmitting soncotuoy. - Additional information svailatdle fcr 
use included aircraft heading, altitude, and airsyeed as 
well as doppler velocity and drift angle. Also, the 
aircraft’s Inertial Navigational System (INS) provided 
seogradghical position although the Schuler cycle and 
inertiel drifts could make this position several nautical 
miles in error. On the other hand, aircraft~-to-sonobuoy 
range and sed surface drift information were assumed not to 
be available. An attempt was made to determine sonobuoy 
position at least relative to the aircraft with a less 
accurate ze0graphical Dosition as a secondary otjective. 
Xalman filtering techniques were used based primarily on 


measurements of bearing from the aircraft to the sonobucy. 
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Il. FILTE 


He 
ep) 


Kalman filtering is a recursive technique for estimatin 
the state of a system. It was developed in the 1962s by 2. 
E. Kalman and improved upon previous methods oy Wiener and 
others. The Wiener filter is based on frequency domain 
designs which are statistically optimal but are only 
applicable to stationary processes. The Kalman filter is 
based on state-space, time domain formulations and is 
esoecially suited to digital computers. Frem a simplistic, 
one-dimensional point of view, the Kalman filter recursively 
averages roisy measurements to orcvide 4a more precise 
estimate of the actual value. 

Assume that a system can be linearly modeled with state 


equatiors in matrix form as 


ke oe ° ee ° uaa 

where = represents the states of the system at the <th 
interval. (Only the discrete case was be considered in this 
study.) oF is the transition matrix and is used to 
“sropagate the system from kK tc X+1. u reovresents the 
cortrol ifput to the system and x reogresents white, 
guassian noise with 8 mean and - variance, written Ree a 


Measurements are required to ucdate the system anc are 
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described by the linear matrix equation 


MS 
H 
ti 
>< 
+ 
<j 
nh 


where Zh is the measurement. a @escril0es the reletionsrlyp 


between the states and the measurement and ve is measurement 
noise described by N(O,R,)-. 
The discrete Xalman filter equations are: 


rropagate 


x (-) X (+) 
_ = + 
k “kt key SY 
P ~ = + T + + 
7 “kel key oF Shey 4) 
Update 
-l 
* 1 : fi id 
= - p - ee =. 
eo Pg(-) BE [HPA (-) EE + 2 eu 
x + = x ~ + —- #H x - 
mA ) x ) Gy 2, HX | | (6) 
5 = —_ = a. {re 
Ba ) E 8, | nae ) (7) 
ynere 
A 
X = h ] 
- estimate of the state AY 
a lance 
: covariance 
z = Salman gain 
k 
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The estimate prior to the measurement is denoted by Xe (=) 
and can be updated after the measurement to a new estimate 
denoted X.(+). This notation is shown in figure 1. The 
covariance matrix provides a statistical measure cf the 


A 
uncertainty of X. Consider a ex g covariance matrix where 


the error x in the estimate is defined as i - > ae 


E(x) ) —oE(, ¥, ) o; O, oe 
Po o= = (=) 
Bex, x) E(X, ) Gc. o, 
i | L J 


The diagonal elements represent the mean Square errors of 
the corresponding state variebles x, and x,. The 
off-diagonal elements are indicators of cross-correlation 
between the states. The Kalman gain = is an optimal gain 
choosen so as to minimize the sum of the diagonal terms of 


the covariance matrix. 






Priel t +) 


They Ty 
TIME ——? 


figure 1. Kalman filter notation 
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If either the system mcael or the measurement mcael is 
non-linear, then non-linear filters must be used. Let the 


non~linear system be descrited ty 


oa } View MGR, ) (12) 


A 
where P(X) Peuresents the non=linedr equations of “tue 


system. They can be linearized by a Taylor series expansion 
“Aw 
around the latest estimate of the state to obtain Q(,). 


Lixewise, n(X, ) represents the non-linear measurement 


A 


equations and by a Taylor series expanicns yields H(X 


ye 


k 
gH) = 0K) + BR |e - a) e (11) 
nih) = ah) + eGo fa A] +e. (12) 
where 
Acie _ a . Z 
Q(X) = re scx] Ce) 
w(K.) = 2 n(x } (14) 
k ax k me aa 


second oraer Taylor series terms are neglected. Now, the 
extended Kalman filter can be implemented with the fcllowing 


eqduetions : 
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Propagate 


K (7) = 6K) (15) 
Pe(-) = OX, (-)) Pet) DUKA) a, (16) 
Update 


Higher order filters can be used if the linearization 
errors are large. The second order <almarn filter employs 
one more term in the Taylor series expansion by medifing tne 
Medete equations Of toe exvenaed Kalman filter tocacccunt 
for this term. The iterated extended Kalman filter uses the 
Same @quaticns as does the extended Kalman filter. Eowever, 
the calculations are repeated, each time linearizins 4odout 
the most recent estimate, until there is little further 
improvement with Sach new iteration. The iterated extended 
filter can greatly reduce the errors due to non-linearities, 
More so than the second order filter. 

Kalman filters should be based on correctly modeled 


Systems and accurate noise statistics to Ensure reper 


1? 





performance. This is not always possible either due to 
ignorance abcut the system or lack of sufficient statistical 
information. A filter which is not o,erating properly may 
diverge. Apparent divergence describes that situation where 
the true estimation errors are larger than tne filter 
predicted errors although they are bounded. True divergence 
is characterized by errers which continue to grow with time 
and eventually become infinite. These divergence phenomenon 
ere devlcted In ¢leure 2. 

There are several ways to overcome the divergence 
problem when the modeling is not completely accurate such as 
gidime fictitious noise. This allows the filter a little 
more freedom to adjust to whatever modeling inconsistencies 
may exist, but makes the filter estimate appear more 
erratic. Another method which helps overcome divergence is 
finite memory filtering. Since Kalman gains tend to grow 


smaller and smaller as time passes, they may reach a yJoirt 





: : 

[a 4 Ce 

us TRUE a 

WY WY 

= 2 
THEORETICAL THEORETICAL 
TIME TIME 

(a) Apparent Divergence (b) True Divergence 


Figure 2. Divergence 
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wnere new measurement information has no effect on the 
estimates. Finite memory filtering effectively eliminates 
old data which is no longer useful by keeping the gains 
significant. This is sometimes called a moving window . 

Some simplifing techniques used in Kalman filters 
include precomputed gains. Although forfeiting the optimal 
Kalman gains, this has the advantage of reducing 
computational burden. More importantly, the gains can te 
controlled to overcome modeling weaknesses if necessary. 
Another technique which can be used when more than one 
measurement is provided to a filter is processing them one 
at a time. This avoids taking the inverse of more than a 
scalar when computing the updated coveriance matrix PL (+). 
This is possible if the simultaneous measurements are 


considered to be taken sequentially over a zero time span. 
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Lit. MODEES 


A. GENERAL APPROACHES TO SYSTEM MODELING 

The aircraft-sonobuoy system must be modeled in 
state-space for use with the Kalman filter. There are at 
least two approaches to the modeling of this problem 
depending on the point of view. One intuitive approach 15 to 
assume the sonobuoy drifts at a constant velocity and then 
use aircraft-to-sonobuoy bearing measurements to locate the 
soncbuoy. The states become sonobuoy pesition and sonobuoy 
velocity. Unfortunately, this problem is not observable. 
The bearing measurements provide only information about 
position; there is no rate of change information in the 
bearings themselves. In addition, the aircraft must 
maintain a track of its geographical position between 
updates in order to determine tne next expected measurement 
for the Kalman filter. As mentioned tefore, this aircraft 
position is subject to non-linear as well as linear 
navigational drifts which are rot taken into account in this 
model. However, an observable system can be obtained by 
reducing the number of states to sonobuoy position only and 
introducing fictitious process noise to account for the 
drift. This noise effectively allows sonobuoy position to 
update so as to Keep up with the drift. One approach 


developed ty this thesis is a variation of this concept. 
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Another approach considers only tne relative position of 
the sonobuoy with respect to the aircraft. Relative 
velocities and relative accelerations must be taken into 
account and these change radically as the aircraft flies in 
the tactical situation. Sonobuoy position is not obtained 
directly. (When only the word position is used it will 
indicate the position relative to an earth fixed coordinate 
system, such as latitude and longitude. ‘Relative position’ 
will always mean the location with respect to an aircraft 
fixed coordinate system.) 

There are some other considerations which should be 
addressed. The sonobuoy drift is generally slow (less than 
5 NM/Hr most of the time) and constant. It is not 
unreasonable to assume that the entire sorobuoy field drifts 
at the same velocity. Another point is that aircraft 
navigational drift can not te distinguished from sonobuoy 
griet. ip Other words, the-drift that is preceived by the 
aircraft is the combination of sonotuoy drift and aircraft 
MavEsationa] drift. If this nayvigationa! drift. is° linear 
and not excessive it causes few problems. However, 
non~linear navigational drifts, such as the Schuler cycle, 


can cause large errors. 
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B. THE COORDINATE SYSTEM 

A right-handed coordinate system was chosen as depicted 
in fizgures 3 and 4. This is a departure from the work of 
Orincon Corporation which is described in the next section. 
This system allows all angles to be measured positive in the 
direction they are normally aqefined, i.e., aircraft heading 
measured clockwise from north. It also coincides with the 


usual aerocynamic coordinate system. 


Kast 


5 = Aircraft heading, + clockwise 





Down 


Figure 3. Barth fixed 
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Figure 4. Aircraft fixed 
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GC. Gos SIX-STATE SISTEM 

Orincon Corporation of La Jolla, CA., completed a 
technical report in December of 197& concerning the Sonobduoy 
Reference System. They were contracted by NADC to 
investigate the effect of errors in the aircraft 
navigational system on the performance of the sonobuoy 
tracking procedure. As a result of their work they 
developed a 13-state mathematical model which successfully 
determined sonobuoy positions in spite of these navigational 


errors. The complete state vector was 


_— 
s fax, ie er a n.| ie) 


> 
be 
il 


relative position of the sonobuoy from the aircraft; 


Av = relative velocity of the sornobuoy from the aircraft; 


X = position of the sorobucy on the océan surface; 
ve=velocity of the sonobuoy on the ocean surface; 

ioe eer otal system's platform azimuth alignment errors 
m = inertial system’s gyro drift rates assumed constant. 


(Subscripts 1, 2, and 3 represent North, Hast, and down 
respectively.) The model was developed using state equations 
which described sorcbuoy motion relative to the aircraft and 


relative to the ocean’s surface. These were derived by 
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Grincon frem 
me fi = 
i Ga (Xo + §) (21) 


and other mechanization equations to obtain 


AR SAV, 
AX = V5 
a wy Zar ~ AX,) — ¥349 7 H98 
AVY, * “Ry is w(x, ~ ta ~ AX) — w34) 7 018 (22) 
mY 
y= Vy 
a = Q 
u = ¥ 
where 
x = aircraft inertial navigation system position 
© = aircraft inertial navigation system error 
H = vector from the center of the earth to the aircraft 
2 = acceleration due to gravity (assumed constant) 
w = Schuler frequency e/R 
A = aircraft accelerometer outputs 


The sonobuoys were assumed to drift at a constant velocity 
and the aircraft was assumed to fly at a constant altitude. 


The inertial alignment errors were described by 
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Y= Py oo 0 ioe PxQ2cosrk + Mm, 
Wo = -W,Q sins + m, (25) 


by = y2 COsr 


where 


earth rate 


~ 
I 


latitude 


o 
F 


There were several sources of measurement information. 
Aircraft to sonobuoy bearing was available from the aircraft 
interferometer system in the form cf cos? where 6 is the 
angle between the direction to the scnebuoy and the base 
line of the antenna. Doppler velocity and drift angle from 
the aircraft doopler radar system provided information about 
Av, and Av, The only other relevant source of measurement 
information would have come from GPS (Global Positioning 
System) which would have provided error free aircraft 
BOSITLION. 


Orincon performed a numerical otservability analysis on 


this system based on the observability matrix Me given by 


N 
: Te | 
Me 2 WHT RH, & (24) 


If this matriz is positive definite for N2z then the system 
1s considered observable. In addition, an eigenvalue 
analysis provided informatior as to the conditioning cf the 


system. The result of their analysis indicated that the 
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system was not fully observable with measurements from the 

interferometer and dovpler systems alone. Only ten states 

were observable; sonobuoy position most likely was not 

a Vy and Vv, were weaxly observatle 
at test. They also noted that observability is reduced 


otservable and W 39 Mis m 
when the aircraft pursues a straight flight path . By 
removing sonobuoy positions and gyro drifts from the system 
they found the observability improved. fFurther, tne system 
became fully observable if sonobuoy velocity was also 
removed from the state vector. 

The Orincon report presented the results of a 
Monte-Carlo simulation on the id-state system. However, 


they concluded that a reduced state filter made up of 


would provide a worxable solution to the problem although 
they noted that it had a tendency toward divergence. It was 
moryey the intention of: this Tesort to further the 


MVvVestieatlon Of this reduced state filter. 
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The state equations for the reduced six-state filter can 


be obtained directly from Equations (22) and (23). 


AX, = Av, 
AX, = Avo 
re = = D S L - 
AV, = Ry + Ww (X, Kai Ax, ) + Wo8 (26) 
° : 2 I 
Av, = “Kh, + wW (xX, = ia Ax,) - 0,2 
vy = V5 Sind 
Vo “by Sind 
where Vas ms and m, are set to zero. In matrix form 
Ax 381801 @ g AX 3 
1 1 
; | | 
AX, ‘iy: eles ame oe g AX, M) 
AV So odo ) 2 -2 AV -R + w(x. -x!.) 
 —— 1 = | : ~ al 
; sil 
— ‘ ~ = 
AY, i 70" : Deke 2 ae Av, js rs w(X, Xo) 
v, 2 2 8 @, @ -AQsinvl] o, J 
| 
V5 Od Bo oO 1 0sie 4) Vo my) 
which can te abreviated 
, A 
aS | aoe 
X = [> [ eerh + 5 (27) 
2 , av 
| 
Expressed in discrete time the state equation is 
nee oR. GAL Wee) 
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The discrete formulation of the plant matrix can be obtained 


4. eft (29) 


from 


5 ae: 


g =f: 








Developing this 


ee es ee) | M, 1, 
Zs 09 1 | y, g 
Dog esa” We 2 
51 - | = ; , (3G) 
”, Qos - 2 
ee ee oe 
9 2 2 @ | Ss Qsind 
Q9 3 6 2 7asink : 
from which the determinant of the system is 
sI - | = (57 + y*)4(54% + Q*sin*y) 2 (31) 





The inverse of this matrix and its Laplace transform are 
presented con the follcewing pages as Equations (32) and (33) 


respectively. 
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The discrete formulation of the continuous matrix Bis 


ties ee 
es = e dA B where X} = At - T (32) 
=. 
Hence 
R, _ 1 _ 
{ we + (x, Ky} (1 coswAt) 
Sa + (X, - x)} (1 - coswAt) 
{=< + w(x, - x )} sinwAt 
= u) i al ca 
AL im R T (35 ) 
{-=2 + w(x, - x -.)} sinwAt 
uw) 2 a2 
4) 
4) 


The noise term is Wee N(@,9). The variances are estimated 
to be .J1 NM for relative position, 1.2 (NM/Hr) for relative 
velocity, and .dd@1 radians for inertial misalignments. As a 
result, the following constant diagonal matrix is usea for 


im) 


es 
cor 
81 0 
0 ~8d1 
O01 


The same measurement information is available as before 


BEE 





in the larger system, namely interferometer bearings end 
doppler velocity and drift angle. These introduce non- 


linearities and must be modeled as in Equation (19). 


A Teylor series expansion as in Equation (11) about the 


latest estimate of sonobuoy position y,rovides a method of 


linearization. As a result 
































To determine z and its partial derivatives, recall that 


ae cos@ = BX + RE ( 


where AY is the unit vector representation of a line from 


the aircraft to the sonobuoy ane RB 2S he UN1Lt vector 


descriting the -ase line between the antenna pairs of the 


interferometer. 











m AX, AX, Ae 
z.= cosa = = no he + Rs 
1 A if A 2 A 3 
mae | Ax | Ax | Ax | 
ra /~ 
‘ 7 Ax, RB, + Ax, RB, +h RB, 2 
~ A 1. = 
1 (AR |” rf ak, ac 


where nh is the aircraft altitude. 
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5 5 
Ae as Sal @ G oo a | (4g) 














9Ax,| 3 Ax, 
wae ke ah AeX 
A A A 
aoe ; a AZ,(AXRB, +AxRB, +hRB) a 
2 A 
Idx, ? : (aR +083 th?) 7 : (ARS + Az’ + h’) 
A>X 
A A A 
a ; . AR, ARRB as cx Rees 
a ee = se no a aa ESI Ya a 
aax, * | (ARTHAS 5th ye | 7 (ak, + aS +h?) | 
X=X 


The doppler velocity, Ve is a measurement of aircraft 
speed relative to the ocean surface and doppler drift angle, 
B, is a measure of the angle between aircraft track and 

aircraft heading. These measurements can be related to the 


State vector by assuming the sonobuoys drift at the same 


velocity as the ocean surface. If this is true then 























= Z aes 
= (A 4 
Z. (Av Avs) (44) 
aZ ) z 
H, = | @ 2 2 2 2 2 (45) 
9 Avy ; 3 Av, 
=X vx 
wnere 
92. Avy 
2 = Ee (46) 
d Av, ef (Av, + Av 5) 
7.2 Av 
2 2 5 : 4 (47) 
fa. 
d Av, (Av, + AV ik 
oe 1 Zz 
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Similarly, 


or since the aircraft heading, a 














Track = fWeacinge 


=| Av 
tan —2) =e 
Av, 7 











, 15 CeGerministic 


(J) 
CA 


~{ Av, 
Zz =H + g = tan |—< 
3 Av 
l 
92. QZ 
Hg = | 0 @ Mm) 2 
dAv, gd Av 
= «7X 
where 
ne 
re) Z 4 ~ V5 
Poe A2 
dAv, Av, + Av, 
K=X 
3 Av 
*3/ = a 
AN uN 
7 Av, , Av, + Av. 
(2X 
Finally, 
cos8 
4 = V 
d 
Hee 46 
et 
d(cos & da(cos 9 g 2 3 
xy x 
a = a d (va ) 3 (vy ) 
dAv, dAV, 
g Z oCHe+8) 9(Het+8) go g 
| AV) aAv, | 
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The measurement noise, V,, is described by E82) acl ae 
is assumed that the measurement noise R and the plant noise 
Q are white, zaussian, and uncorrelated. S5ased on 


information obtained from NADC, k was assigned the following 


Values: 
a 0087 rad (interfercmeter) 
R, = 1.9 (NM/Er) (doppler velocity) (55) 
Ry = .@1 deg (doppler drift angle) 


It should be pointed out that the doppler measurements 
are not always available. The doppler system freezes the 
last value of groundspeed and drift angle anytime the 
doppler radar is not receivirg good information. This 
happens whenever the aircraft is above 5Jd0° altitude, or 
can happen when flying aoove a cloud cover or when the sea 
surface iS too smooth. As a result, the doppler could be 
inaccurate during a significant portion of the flight. 

The six-state system was programmed and tested for 
several conditions. Flow charts for significant portions of 
the program and the entire program listing ére resented in 
Appendix A. The main program hes two purposes: first, to 
control the simulation; and second, to read and prepare 
measurement data for the subroutine FILTER. This suoroutine 
performs all the Xalman filter computations as specified in 
the abceve equations. The Carlson square root tecnnique is 
used to ensure a positive definite covariance matrix. Also, 
in order to avoid inverting a matrix in the calculaticns for 


the Kalman gain, the three mé€asurements are orocessed one at 
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a time. The results of the simulation are presented in 


section [V¥.38. 
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Peo tHe TWO-STAle SYSleM 
An attempt was made earlier on in this research to model 


sonobuoy motion as 


a) 
I 
od 
+ 
ae 
x 
ea 
t+ 


With a state vector made up of x and u,. This 


oe 2 
system proved to be unobservable although the simple 


u 


approach was appealing. Since sonobuoy drift rates are 
generally slow, another attempt was made to model the system 


without velocity. The equations reduced to 
X = X + W (27) 


Helton Ly x and x, as states, this system was observable. 
By describing largestatistical values of system noise thers 
would hopefully be enough freedom in the usdate te 
compensate for any sonobuoy drifts. Unfortunetely, this 
approach was not completely successful; however, it was 
observed that the general direction of sonobuoy crift was 
correct. As a result of these investigations a technique of 
cascading Kalman filters was used to solve the tracking 
protlem. The intent was to use results from ore filter as 


measurement for a second filter. Ther, the result of the 


a7 





second filter could be used as a deterministic control input 
to better prooagate the first filter. 

Two Kalman filters are used in this appreach. Figure 5 
snows how they are related (or cascaded). The first filter 
models sonobuoy position and is based on the discrete state 


equation 


Kk = x + U, At + ds (58) 


The state vector consists of the sonobuoy positions, x, and 


Xo. UE iS.a deterministic input accounting for sonobuocy 


drift and We is system noise. The interferometer 


measurement, cos9, is used to update this filter. 


co3 6 







xy pCSit10n Mae 
filter 
K ie 





filter 


Figure 5. Cascaded Kalman filters. 
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The second filter models the sonobuoy drift with the state 


equation 


As the sonobuoy’s position changes with each update of the 
position filter, the velocity required to move from AY to x 
in the time interval At can be calculated. This value is 
used as a measurement for the drift filter. All sonotuoys 
contribute to this filter which produces one cveréll 
estimate of drift for the sonobuoy field. This value is 
then uséd a$ an input to the position filter when the rext 
interferometer measurement occurs. 

The technique is understandably sensitive tc the output 
Oueune Critte filter. Livpae estimated drift, is too. mucn i2 
error, the estimated yositions will be affected. Divergence 
eould result. for this reason, a simplifiec salman filter 


ls used to estimate the drift. It is of tne fcrm 


The gain is precomputed from i/(n+1) where n is the total 
number of measurements and is limited to a value at least 2s 
zreat as At/(&4 min.). This limit is reached after the 
first S54 minutes of tracking time. From that point cn the 
gain remains constant effectively averaging the drift over 


ene period of the Schuler cycle. It must be understood that 


a7 





the drift this filter estimates consists not only of 
Sonobuey drift but dlrcrart drift es well end 125, in fact, 
the vector sum of these. An estimate which attempts to 
follew the changing velocities tnrough the Schuler cycle 
tends to cause the position filters to diverge. This might 
be the case if larger values of gain are used, averaging 
only the last few measurements of drift. Therefore, many 
measurements of drift are averaged which provides an 
Sestimate for linear drift only. The Lower limit of e2ain 
prevents new drift measurements from being lignored and also 
provides for flexibility in estimating the drift. 

Unlike the six-state system, the interferometer 
measurement is the only measurement required ty the sositicn 
filter. The measurement equation is essentially the same as 
in the preceeding section where z is determined as shown in 
Equation (39). Since there is only one term in z, the 2 
matrix 15s a row vector consisting of 


(E1) 


h = en 


a 3 2 3 
=] 9X5 


mIN 


where the terms are given in Equations (41) and (42). It is 
Mecessdry to Geternine the elrcrart=-to-scnovuoy Pranse fer 


these values from 


it 
Ps > 
| 
m< 
to 


AX (62) 


“A 
wnere X is the estimated soncbuoy position. a represents 


4Q 





the aircraft position and is considered deterministic. 
Undoubtedly, Xe 1S in @rror due to aircraft navizaticnal 
drifts and therefore causes errors in the estimated 
eeographical position of the sonobuoy. But, since the 
measurement of bearing is based on relative positions, the 
estimate is relatively correct. 

An observabllity analysis on the e2-state position filter 


wes performed again using 
S T T 1 
= —~iL,- A 


SPOCrtuLLoOm into thls formula with Nez yields 
2 
3s niga f alten 
i ae dX, .\OxXar. Ox. |. OR a FOe dg. 
i i +( aa +] 
+> 
Ge \Ge) iz f: \ faz | 
OX x ax,/. 9x1 LX, 7 9X5 +i 4 


¢ 
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This matrix is positive definite for all except the case 


when 











Ge : (32 - Gz) _ =) 
ai Leo 27) wn ger 


This occurs whenever the relative bearing from tne éircraft 
to the sonobuoy is not changing (i.e. when flying directly 
toward or away from the sonotuoy). This is intuitively 
correct since two or more bearirgs must cross in order to 
determine 4a position. 

The two-state system wes programmed and tested to 
determine the usefulness of this simplified filter. The 
majority of the program is the same as the one used for the 
Six-state system. The significant differences occur in 
sudreutine FILTER. The Carlson square root technique is 
used again but only one measurement instead of three is 
orocessed. The drift filter is programmed in this 
Sucrqutine alone wlth the position filter. #Artlow chert and 


program listing are presertec in Appendix A. 
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IV. ANAYLSIS 


he 6 THE o IMULAT ION 

Actual data from the Orion was not easily obtainable for 
this research. Consequently, a computer program had to be 
written to generate the information required by these 
algorithms. A flow chart in Appendix B descrites the 
program. An aircraft track was created by alternating lines 
and curves of various lengths and then a determination of 
noise free measurements was made as tne track was flown. 
(Measurement noise was added later during the simulations.) 
Sonotuoys were allowed to drift at a constant velccity, and 
the aircraft’s navigational drift was modeled with a 


constant velocity and Scnuler cycle variations as 


K7 = kK, + K At + Aysinut (66) 
where 

xt =sditeratt intertidal. 0511109 

x = aircraft true position 

w = Schuler frequency ,/g/2. 


The constant drift rate, As was found by NADC to have 2 
mean and a standard deviation of 2.5 NM/En. Likewise, tre 
amplitude of the Schuler cycle, AL had 2 mean and a 
Standard deviation of .5 NM. The effect of wind was elso 


available in tne program but was never included fcr analysis. 
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It vas obvious that both algorithms were extremely 
sensitive to the aircraft flight path. Since there is no 
"typical flight path for an Orion during its on-station 
period, several uniform patterns were selected which vould 
provide meaningful information on each algorithms 


performance. These base parameters were chosen: 


airspeed 16d kts 

altitude Sg0e ft 

range lo NM adlrcraft—-to-sonooucy 

frequency eg sec between measurements on one sonobuoy 


A circular pattern wes flown around a sonobuoy at a réenze of 
about 15 NM. Initial sonobuoy placement was at (1,1) with 
tie aircraft flying clockwise starting <t (ha,v). Enis 1s 
shown in Figure € which depicts a portion of the aircraft's 
true track. Sonobuoy drift was west at 1 NM/HR; aircraft 
navigational drift was south at 1 NM/HR and includec a 
Schuler cycle (amplitude .5 NM) when specified. (This drift 
would be indicated in Figures 1¢ thru 24 ty the follcwing 
notation: Dk=(a/ce 160-1 + Schuler, b Z70-1) .) The scnotucy 
remained near the center of the pattern allowing the range 
to remain relatively constant. This was desirable since 
this basic flight path was used to test the response of the 


abvorithms to variations in altitude and range. similarly, 


a square pattern was flown counter-clockwise around a 


1 ; 
(x, ,X, ) measured in nautical miles from an arbitrary 


origin near the aircraft’s starting ,oint. 


i 





sonotCuoy at a range of 15 NM. I[n this case the aircraft 
weeamOn=top the initial position of the sonobucy at (-—¢;—3) 
and preceeded to fly the track shown in Figure 7. The 
sonotuoy was allowed to drift to the east at 2 NM/ER and the 
aircraft’s navigational system to the north at 2.5 NM/HR. 
This pattern was used eventually to analyze performance at 
different measuring frequencies. Figure 8 shows the output 
of the aircraft’s navigational system when it has a 
northerly crift of 2.5 NM/EHR while the aircraft is flying 


the square pattern. Figure 9 shows this same pattern when a 


Schuler cycle with an amplitude of .& NM is also present. 
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These patterns were used to generate the data which 
included sonobuoy number, time of measurement and 
measurement, aircraft latitude and lengitude, altitude, 
heading, pitch angle, roll angle, AN-S acceleration, E-W 
acceleration, and the antenna used for the measurement. 
Also determined, but used only for error analysis, were 
sonobuoy position and true aircraft position. This 
information was computed for the entire simulation period 
and stored in a file to be used when needec. 

Initial estimates of the state and the square recot of 
the covariance matrices were obtained as follows: 


5S1X—s tate 


x(0)-x (2) 5 
ay 
X(8)~-Xal(d)+.5 S 
“V4 COSH oe 
X(2) = S_ (3) = (67) 
-V, sind D 5. 
y) 22020 
g 0025 
Two-state 
x, (9) oles 
X(d) = 364) = (68) 
x, (O)+.5 Alt 


where 5, (8) indicates the diagonal elements of S(2d). 
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For the circular pattern 


x, (8) 


x, (9) 


and for the square pattern 


The initial values of the co 
describe the errors in the 5 
sonobuoy frem an aircraft. 
Fetter with a lower Initial 
system. 

Simulations were run for 
Each unit of data was sequen 
program from the storage fil 
with the following normal di 

ceos9g N 
dopoler velocity N 
doppler drift angle N 
shese values agree with the 
previously. A random number 
was used to create the noise 
After the estimate was made, 


Manipulated in subroutine RE 


Pane = 15 

x (9) = 4. 
72 

y a 9 ee 
al 

x (2) = -3. 
a? 


Variance were chosen so as to 
tate associated with dropping a 
The two-state system operated 
Variance than did the six-state 
two ours. 


a rominal pericd of 


tially read into the simulation 
ee. Measurement noise was added 


Siri butions 


(0,.d007) in radians 

(0,1.¢) in NM/ER 

(Oe .01} in degrees 

ones chosen for rk as describded 
generator using an initial seed 


[Promo Bhe oho ler Gist rioutions. 
errors were measured ard 


SULT. This cycle was repeated 
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until the simulation was complete. (Refer again to Appendix 
A for a flow diagram of the simulation process.) 

Information was gathered and is presented primarily in 
two weys. First, for both the sdquare ard Circular catterns 
the results of the first run of the simulation are plotted. 
(Figure 13 is an example.) The top portion of the results 
shows the estimated positions of the sonobuoy on the 
aircraft’s navigational plot. It should be noted that these 
are not true positions since inertial errors may be causing 
Valse plot tO drift. [he bottom sSortion shows the 
North-South and East-West errors in the estimated positions. 
These errors are the differences between the true and the 
estimated relative positions of the sonobuoy. They are 


depicted in Figure 12 and were computed from 


AX, = AX ~ AX, (69) 
*#*® 
L 
— ry, = Pa = _— 
AX, (X a (x Koy (7d) 


wnere AX, is the relative error at time k. The true aircreft 
AXS 






A 
x 





Earth fixed coordinate system 


Figure 18. The effect of the aircraft navigational plot 


pre 





position is denoted by Ky and the true geographical position 
of the sonobduoy is denoted by X. These values are «cnown 
from the simulated data. x is the filter’s estimate of 
position and K* is a deterministic input from the aircraft’s 
navigational system. The errors indicated in these plots 
are different from those perceived in the upver plot 
whenever the aircraft’s navigational picture is drifting. 
The tositive and negative values of tne square rcot of the 
covariance are also shown on these glots as solid lines. 
SOecCLITicelly, 


N-S error 


it 
\-+- 
td 
_— 
- 


E-W error 2 9 


2 
(Only position errors are analyzed in this resort.) 

The second way in which the information was gathered 
consisted of a shortened Monte-Carlo simulation. For each 
scenerio under study, 2@ two-hour simulations were run, each 
with new values of measurement noise provided by the random 
number generator from their respective distributions. The 
objective was to compare the RMS errors predicted by the 
covariance matrix in the filters to the actual «AMS errors 
observed in the simulations. Three KMS statistics were 
collected and plotted versus time as follows: 

1. The square root of the covariance comouted by the 


Kalman filter is represented by a solid line on the 


Rlets. It was computed from 


Ih 1 a 5 2 
OG = al P a cae P ? n=2¢, Kk ae Tee yh ates 7) 
er by ate oe 


Do 





Cn 


This standard deviation is the filter’s estimate of 
its accurecy. 

The mean and standard deviation of the error in the 
estimated sonobuoy position relative to the aircraft 


was determined by 


Nh 
= i YX = = 
Me =A mi? BT 20, K = 142,35... (72) 
i=l 
lh 
2 ieee ae : 
_- ag ict toon = 205 we ee, coce, X75) 


This standard deviation is represented by an “X” on 
the plot and is a measure of the variability in the 
filter’s estimated position. 

The RMS value of the actual relative error was also 


also determined. It was computed as 


and is represented by an “O° on the plot. This value 
is a measure cf the error which occurred between the 
actual relative position of the sonobuoy and the 


estimated one. (See Figure 11.) 


These values are plotted over tne two hour simulation period 


(4 = 


1,2,6-.-) and provide a measure of the accuracy 


obtained by each of the algorithms. 
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Ee THe RESULTS 

Orlncon Corporation periormed much of thelr anadysis 
using the small circular pattern shown in Figure le. fhe 
aircraft sped around this track at S&E Knots taking a 
measurement every <@ seconds. Altitude was constant at Svdd 
feet. The initial position of the sonobuoy was at (2,2) and 
it drifted on a heading of 045 degrees at 5.5 NM/ER while 
the aircrafts navigational system drifted in the opposite 
direction at 5.2 NM/HR. A Schuler cycle was alsc 
Superimposed on this drift. 

The initial estimates of sonobuoy position and variances 
used by the algorithms were different for tnis particzular 
Pavlekn in order to-coincide with the Orincon simulation as 


much as possible. They were 


Iwo-state 
g 2 
K(3) = $)(8) = (74) 
d on 
& 
Six=state 
—5,4 Ls 
v4) z 
~V, COon om 
X(3) = Se) = (75) 
mild oe 
4) IO25 
%) JY25 
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a =-4 w/s° =-0.4 g 
V, 200 m/s 


Vz = 2.8 M/S 


Figure 12. Orincon's simulation flight path. 
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Initially, both the six-state and the two-state 
algorithms were tested using this flight path and 
comparisons vere made with the results cf Orincon’s 13-state 
system. It was discovered that the six-state system’s 
results did not change as a consequence of whether or not a 
Schuler cycle existed in the navigational system. 

Therefore, the six-state system was run cnly with the 
Schuler cycle active. The two-state system was run with and 
Without a Schuler cycle. 

The results of the first run of the simulation are shown 
in Figures 13, 14, and 15. The sawtooth shape of the 
covariance (solid lines) is the result of the circular 
pattern and is caused in two ways. Frimarily, since the 
soncbuoy remains closer to one side of the circle, there is 
a minimum value of the variance each time the aircraft 
pesses on this side. A second reason for a change in 
variance is the aircraft’s location iz the pattern. 

Fowever, these modulations are net as apparent since the 
range variation dominates. kMS errors were obtained by 
repeating these runs 22 times anc are shown in Figures 16 
thru 18. The fluctuaticns generated by the flight path are 
apparent, more sc in the six-state system than in the 
two-state system. Also, steady state values cf the error 
gradually increase. This is true vecause the average ranze 


to the sonobuoy increases as the buoy moves farther away 


So 





from the center of the pattern. (It will be demonstrated 
later that the errors are range dependent.) The covariance 
of the six-state system increases from 43d yards at <5 
minutes to 8@@ yards at the end of the simulation. The 
two-state system increases slowly from 25¢ yards until it is 
hampered by the Schuler cycle. It is worthy of note that 
without the navigational errors stemming from the Schuler 
cycle the HMS errors of the two-state system are 
considerably lower than those of the six-state system. 

Table i compares the RMS errors of these two systems to 
the results obtained by Orincon for their 1i3-state system. 
(The values for the two-state and six-state systems are 
taken from the covariance at a point 35 minutes inte the 
simulation.) The first line considers measurements of 
bearing, dopoler velocity, and drift angle. Navizational 
errors are present including a Schuler cycle. As expected 
there is an increase in relative oosition error because of 
the reduction from 13 to 6 states. The next line considers 
the effect of the Global Positioning System (3FS), with very 


accurate aircraft positioning information, on the relative 


|| tw state | estate | estate 
Schouler 

394 452 
SRStdv+DA 






No Schuler 


452 220 
SRS+DV+DA+GES | ! 


Table 1. Comparison cf KMS results in yards. 


hey 





position errors of the sonobuoy. In the 1ldé-state system 
Orincon observed that the errors in the states pertaining to 
the aircraft inertials improved markedly; relative position 
errors most likely remainea the same. This is exactly what 
was found in the analysis of the six-state system: that the 
relative position errors were unaffected by navigational 
errors. However, the two-state system is very much affected 
by navigational errors. Relative position errors were 
Significantly less for the two-state system wnen accurate 
aircraft positions were known. 

To obtain a tore realistic analysis of their performance, 
each algorithm was tested using the circular and square 
flight patterns of Figures 6 and 7. The results of the 
Berst simulation run for the circular path at a@ range of 12 
NM are shown in Figures 19 thru ¢1l. In this case, the wavy 
nature of the covariance is due to the location of the 
aircraft in the pattern since the range to the sonotuoy 
remains relatively constant. For instance, as the aircraft 
passes directly north or south of the sonobuoy the apvility 
to correct B-W errors is greatest. Therefore, the E-w 
Variance reaches a minimum value at this time. The N-S 
variance is affected in a similar manner. The two-state 
filter is not as sensitive to this as the six-state filter. 
Also, the effect of the Schuler cycle on the two-stete 
maiiter can be seén in Figure 2o. 

The RMS errors are shown in Figures 22 thru 24. The 


Steady state KMS value of error predicted by the filter is 
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425 yards for the two-state and 75¢@ yards for the six-state 
system. The actual RMS error in the relative position of 
the sonobuoy is 256 to 1206 yards for the two-state and 449 
yards for the six-state system. Without Schuler cycle error 
the two-state system drops to a steady 258 yards, better 
than the six-state system. It is interesting to note that 
the measured errors are significantly less than those 
predicted ty the filter. SBoth measured values of KMS error, 
oy and Oo) are in close agreements that is, the deviation of 
the filter’s estimated position about its mean is generally 
the same as the deviation of the estimated position about 
tne actual relative position of the sonobuoy. The closer 
these values are to one another, the more confidence can te 
placee In the analysis. The cnly excestion to this is 
Figure 23 which shows the reaction of the two-state filter 
to the Schuler cycle. One complete cycle with a pericd of 
G64 minutes is obvious. The Kalman filter does not recognize 
this cycle since the modelirg equations do not account for 
it. The dip in the center of the two peaks is once again 
Phe pesuit of flight path seometry. [he daircreft is in such 
a position relative to the sonobuoy that the measurements 
provide enough information to correct for Schuler cycle 
Srrors. However, it 1s not im this position lope enon. to 
influence the errors anymore than it does. 

The same analysis was performed using the square 
pattern of Figure 7. This scenerio has more drift than the 


other and in a different direction providing the algorithms 
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with another motion to track. The outcome vas generally the 
same as can be seen in Figures 25 thru 3d. There is no 
measurable difference in tne results from the two different 
flight paths. Flying a straight path does not adversely 
affect the results as was concluded by the Oricon 
Corporation for their 13-state system. The wavy nature of 
the covariance is again a result of the flight path. It is 
not as smooth as before because a square pattern was flown 
imsteed of a circular One. Another look at errors caused in 
the two-state system by tne Schuler cycle can be seen in 
Figure 30. The algorithm doés make some corrections to 
these errors but they are not as effective as before. In 
this case the time the aircraft was in a position to maexe 
the corrections did not coincide with the time the peak 
errors occurred. There appears to be no way to predict the 
Optimum time and place for the aircaft to te without cnoring 
when and how the Schuler cycle is occurring. 

The distance the aircraft is from the sonobuoy is 
directly related to the accuracy the algorithms can achieve. 
Simulations were performec at ranges of 5, 15, $4, and 45 
nautical miles using a circular flight path with the 
sonobuoy in the center. (The RMS plots can be found in 
Appendix C.) The steady state errors were observed and are 
plotted in Figure 31. Solid lines represent the aMS values 
of the covariance and dashed lines represent the actuel 
errors. In all cases the errors increase with distance 


which is intuitively satisfying. Mathematically, the 
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covariance increases because the H matrix becones smaller 
with an increase in range. Consequently, the updated value 
of the covariance, P(+), is larger from Equation (15). For 
the six-state system there is an increase in actual error 


from 248 yards at 5 NM to 758 yards at 45 NM. Aned for the 


Ci 


two-state system, actual errors increase from 1358 yards at 
NM to 50@ yards at 45 NM. (Note that for the two-state 
system, Schuler cycle errors, indicated by circles, peak 
approximately 1080 yards above these plotted values; the 
lower values, indicated by x°s, were used since they were 
more reliable for comparison between ranges.) There is a 
Slight decrease in the slopes of all the error curves as 
distance increases. Hovever, this decrease is small and the 
curves might well have been interpeted as linear within the 
limits of tne analysis. 

The frequency at which measurements are made also 
affects the accuracy of the estimate. Each algorithm nas 
tested with measurement intervals of 4, 18, 2¢@, and Su 
seconds on one sonobuoy. The cutcomes of tne steady state 
KMS errors are plotted in Figure 32. (Once again the 
two-state system's errors do not show the effect of the 
Schuler cycle.) The actual errors in the six-state system 
increase steadily as the measurement interval increases. 
However, the covariance decreases rapidly at first to a 
minimum value somewhere around 1:3 seconds and then increases 
with increasing interval. An abdbreviated run with a two 


second measurement interval confirmed these results. 
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Figure 33. Factors which influence the covariance. 
5S 


Figure 33 helps to explain this outcome. There are tro 
conditions which affect the covariance. The most obvious is 
the increase in covariance due to an increase in the 
propagation interval. This occurs because the plant matriz, 
which is a function of time, affects the covariance in 
Equation (16). The second condition is a consequence of the 
model’s observability. If the relative bearing between the 
aircraft and the scnotuoy does not change then the state is 
rot observable. In other words, two successive bsarings 
must intersect to determine an estimated pesition. 5y 
allowing the interval between measurements to become too 
small, the aircraft is unable to make 2 significant change 
relative to the sonotuoy. The covariance increases as the 
conditions appreach those which make the problem 
unobservable. There appears to be an optimum frequency with 
which to make measurements cn one buoy, namely 193 seconds 


for this range of 15 NM and speed of 186 xnots. 
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Dies twe-alate SyStem Gxbrbited similar characteristics 
i Fieure S22. In this case the covariance néver does 
increase in the range of intervals studied. The actual 
errors remain constant. Since the plant matrix fcr this 
system is equal to the identity matrix and the Q matrix is 
prescribed to be constant, the propagation interval, At, 
does not effect the covariance. However, the effects of the 
observability conditions do cause the covariance to increase 
when At becomes too small. It is believed that as At 
pecomes smaller the actual errors would begin to increase 
also. 

The statistical plots for the range tests found in 
Appendix 3B show that the Schuler cycle causes larger peaks 
in the actual error as the range from the sonobuoy 
increases. However, the peaks are decreasing with time. 
Further simulation revealed that the peax errors decrease to 
a steady value about 1409 yards greater than non-Schuler 
cycle errors. This coincides with the amplitude of the 
schuler cycle as it was programmed for this particular 
flight path. Therefore, in the steady state a Schuler cycle 
may cause additional estimation errors approximately equal 
to its amplitude. 

Altitude was also tested for any effect it mizht have on 
tnese algorithms. Using the circuler pattern at a range of 
15 NM, altitudes of $838, 3002, 12,0380, and 23,20@ feet were 
tested. Neither the six-state nor the two-state system 


Showed any effect for these changes in altitucée. It is 
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believed that at very small ranges (less than two nautical 
miles) altitude might hamper good position estimation. 


However, for the majority of the time altitude is of no 


concern. 
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Figure 14. Est. position and relative errors for the two-state system using 
Orincon's pattern. DR=(a/e 225-5.2 + Schuler, b 045-5.5), At=20s, Alt=3000'. 
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Figure 15. Est. position and relative errors for the two-state system using 
Orincon's pattern. DR=(a/c 225-5.2 + No Sch., b 045-5.5), At=20s, Alt=3000'. 
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Figure 19. 
Circular pattern at 15NM. 
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Figure 20. Est. position and relative errors for the two-state system using 
circular pattern at 15NM. DR=(a/c 180-1 + Schuler, b 270-1), At=20s, Alt=3000' 
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Figure 21. Est. position and relative errors for the two-state system using 
circular pattern at 15NM. DR=(a/c 180-1 + No Sch., b 270-1), At=20s, Alt=3000' 
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Figure 25. Est. position and relative errors for the six-state system using 
Square pattern at 15NM. DR=(a/c 000-2.5 + Schuler, b 090-2), At=20s, Alt=3000' 
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Figure 26. Est. position and relative errors for the two-state system using 
Square pattern at 15NM. DR=(a/c 000-2.5 + Schuler, b 090-2), At=20s, Alt=3000' 
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V. CONCULSION 


The following are the conculsions reached at the enc of 
this research: 

1. The six-state algorithm developed in this revort 
oroduced estimates of relative sonobuoy position with a 
Standard deviation in the error of 5@0 yards at a range 
Ot co NMS Aldrereatt drift. which included te Schuler 
cycle, had no effect on this system since the states 
were defined relative to the aircraft. 

2. The two-state algorithm developed in this report 
produced estimates of relative sonobuoy position witn a 
standard deviation of $dd yards plus an amount eaual to 
the amplitude of the Schuler cycle error at a range of 
26 NM. When no Schuler cycle navigational errors were 
present, the two-state system out-verformed the 
Slx-state system. 

3. Both algorithms showed an increase in steady state RMS 
error with an increase in range. 

4. The six-state system showed ar increase in actual 
Steady state KMS error for an increase in the time 
interval tetween measurements; however, the covariance 
of this system indicated minimum error occurred with a 
1@ second interval on cne sonobdbuoy at a range of 15 NM 
and an aircraft speed of i808 «ts. (This translates to 


14 degree change ir relative tearing.) he two-state 
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system showed no Change in the actual steady state RMS 
error for intervals between 4 and 29 seconds and only a 
slight increase in these errors as a €0 second interval 
was approached. The covariance cf the system actually 
decreased with increasing interval. 

Neither system showed any dependence on altitudes 
within the operational limits at a range of 15 NM. 

No adverse effect was ooserved while flying stréignt 
tracks as opypcsed to curved ones. 

Steady state RMS error was affected cy two conditions 
as measurement intervals changed. The longer the 
interval the more the error tended to increase, 
escecially for the sizx-state algorithm, as a result of 
system propagation. The shorter the interval the nore 
the error tended to increase as the systems encroached 
Upon their non=-cbservalility condition. An optimum 
measurement interval existed for each system which was 


PUNCtiOn of Tanee. 
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VI. SUMMARY 


Both the six-state and the two-state algorithms were 
atle to successfully track the sonotuoy. However, the 
six-state system was the best choice given the navigational 
system in use by the Orion. It was capable of providing 
estimated sonobuoy positions at a range of ¢c@ NM such that 
the errors had a standard deviation of 588 yards. The 
computer time required to process one measurement was on the 
order of 232 milliseconds. On the other hand, the much 
Simpler two-state system required only 2& milliseconds or 
One seventh (>) the amount of computer time. However, its 
estimate of sonobuoy position was degraded by Schuler cycle 
errors in the navigational system. Without these, this 
system was subject to errors naving a standard deviation of 
40d yards at a range of 28 NM. The Schuler cycle 
pericdically increased these errors by an amount equal ito 
its amplitude. 

The algorithms were very much affected by the aircraft’s 
flizht path including the relative location of the sonobuoy, 
the range to the sonobucy, and the amount of angular change 
in the bearing to the sonobuoy as measurements were taken. 
Since the scnovtuoy position was to be estimated in 
twor-dimensions, the aircraft was required tc maneuver in 
suco a way so as to provide information in both dimensions. 


Fer €xample, as the aircraft crossed north or south cf the 


39 





sonobuoy the F-W errors decreased while the N-S errors 
increased. The trend reversed when the aircraft flew east 
or west of the sonobuoy. it was also observed that steady 
state RMS errors grew vith range at a slightly cecreasing 
rate. They were twice as large at 45 NM as they were at 15 
NM. Finally, the sonobuoy position was not observable if 
the relative bearing to the sonobuoy did not change implying 
that two lines of bearing must cross in order to obtain an 
estimated position. If the amount of angular change between 
Cach measurement was too small it began to affect the errors 
because this condition was being approached. Anytime the 
aircraft flew in such a way as to reduce the rate of bearing 
Change, or the frequency at which measurements were made was 
too high, this condition was prevalent. It was observed 
that at least 14 degrees of change was required to avoid 
this problem. 

The six-state system showed no tendency toward 
divergence as long as initial conditions were reasonable. 
The two-state system, on the other hand, did have a tendency 
to diverge when the gains on the drift filter were not 
adjusted correctly. For example, if the gain was to high 
the estimated drift was heavily dependent on the last few 
measurements and was too quickly affected by changes in the 
position filter. But, it was also necessary for the drift 
filter to have non-zero gains in the steady state in order 
to provide some insurance against an initially wrong 


estimate of sonobuoy drift. With these modifications made 
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the algorithm operated correctly during all tests and, in 
fact, had less error in some cases than did the six-state 
system. 

It is the opinion of the author that either one of these 
algorithms 1S an improvement on the historical method of 
“marking-on-top the sonobuoy. Further, it adds a great 
deal more uncertainty as to exactly how much accuracy could 
be obtained in the old way. Non-linear navigational effects 
were not even considered and the number of measurements made 
to determine sonobuoy position was on the order of 148 or 
less for any one sonobuoy pattern. Nevertheless, in an 
operational sense the accuracies achieved here would need to 
be improved. Without the non-linear navigational errors the 
accuracies could have teen much vtetter. showever, the 
results of this research do provide another perspective for 


the problem at hand. 


91 





APPENDIX A 
THE COMPUTER PROGRAMS 


MAIN 


Simulation setup 


Do for the no. 
of simulations 


Read measurement: 
cos @ and antenna 
doppler velocity and drift angle* 


bouy, time, a/c lat. and long. 
altitude, heading, pitch, roll 
accelerometer outputs* 









Simulation 
finished? 








No 


First time 
for this 
buoy? 





NO 





Initialize bucy’s 
state vector and 
covariance matrix 


Process results 





Retrieve buoy's- 
state vector 
covariance matrix 
time of measurement 


Convert lat/long to NM 

Determine antenna baseline vector 
At = present time -.last time 

ay = Neading =“drirc angie* 


Store new- 
state vector 
covariance matrix 
time of measurement 


Process simulation results 





e * Required for six-state 
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Figure 35. Flow chart: Subroutine FILTER 
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Figure 36. Flow chart: Subroutine 
FILTER two-state 
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CAL 
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GLOSSARY OF COMPUTER VARIABLES 


SIMULATION PROGRAM 
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next 

Interval between measurements, At 

Relative position, Ax, 
Relative position, Ax» 
Relative position, ar, 
Magnitude of sonobuoy drift in yards 

Seed for the random number generator 

Arbay of initial drop times for the scngctucy 
Residual, dz 
EPPor in the est. 


relatives Oot on Of SORobucy., Ax) 


2D 





EDELXe 


EOSSO 
EPSLN 


LOST 


EX1 


Error in the est. relative position of sonobuoy, 


Matrix result of ¢ ats ts iy 


Age weighting factor, 


al 


Matrix result of 2-55 


Error in est. geographical position of 


Error in est. geographical position of 


f vector from Carlson square root technique 


T 
aT Gene Moa 


fee 
Matrix result of a 


Matrix result 


Transpose of f 

Gain matrix 

Aircraft pitch angle, yY 

Vector result or. c2 

Gamma in radians 

Aircraft heading 

The H matrix when used in subroutine FILTER 
Time in hours 

Heading in radians 

Transpose of the H matrix 

Index 

SILTER 


Identity matrix when used in subroutine 


Indicator of EOF 


om 
of 


Matrix nesult of | 1s- 
File from which data is read 
file from which true scnobuoy positions are read 
Device on which print is made 


File in which results are written 
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sonotcuoy, Ax, 


sonobucy, Ax, 





NRUNS 


0 


a> 


ae 


File in which random vectors are inspected 
Index for run number 

Index for measurement, z = 1,2,23 
Incremental measure of time 

Latitude 


The latitude of the origin of the local earth fixed 
coordinate system 


Longitude 


The longitude of the origin of the local earth fixed 
coordinate system 


Indicates whether information is to te stored 
or retrieved 


Mean estimated sonobuoy position, uj 

Mean estimated sonobuoy position, u2 

Time in minutes 

Total number of measurenents made on all sonobuoys 
Index when used in subroutines INITAL and DATA 
Integer equivalent of HUNS 

Plant matrix, p 

Matrix result of i) > 

Transpose of gs! 

Matrix result o? O's's § 
Matrix result of @ X 
Covariance matrix 
Aircrait f~oll anele, ¢ 

TT 

Phi in radians 


Variance of plant noise from N(@,Q) 


Variance of measurement ncise from N(30,=) 


at 





RAD 
RANGE 
RANSE2 


SUMS Q2 
SUMAL 


wm /189 

Range to sonobuoy from aircraft 

Squared value of range 

Unit vector component of antenna baseline 

Unit vector component of antenna baseline 

Unit vector component of antenna baseline 
Result of (RB, ax, + RBoax, + RB ,ar,) 

Normally distrituted random number from N(d,1) 
Number of simulation runs to be made 


Array in Carlson’s square root technique which 
represents square rcot of covariance matrix 


Square root of variance, YF} 
Square root of variance, YP22 
Time in seconds 


Matrix result of $ f 


RMS error in the estimate about the actual location 


RMS value from the Kalman filter, VFP,;,+ Foo 


RMS error in the estimate about the mean estinate 


Rate of change of nautical miles for a change in 


degrees of latitude 
Propagated matrix of S$ 


Matrix result of 5$ Ss 


Transpose of S matrix 

Array for the sum of P(1,1) over NRUNS 
Array for the sum of P(2,2) over NEUNS 
Array for sum of az over NRUNS 

Array for sum of sx? over NRUNS 

Array for sum of AX, over NRUNS 
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SUMK2 Array for sum of Axo over NUNS 


sk Last time in seconds the sonobuoy was processed by 
tue fi lver 

TIME Time from aircraft clock in seconds 

U sonobuoy drift vector 

Ul Old value of U(1) 

Uz Old value of U(2) 

VAR1 Variance of the estimated sonobucy position about 


the actual location of 


VAR2 Variance of the estimated sonotuoy position about 
the actual location of 


VARXKI1 Variance of the estimated sorobuoy position eabdout 


the mean estimated position, er 


VARKzZ Variance of the estimated sonobuoy position about 
the mean estimated position, af 


VELCT Relative velocity, aV 


VELCT2 Squared value of relative veclocity 


X state vector 

KAI Aircraft inertial position, Ke 

XatT AlPCratl, True 0esition, A 

al Old value of X(1) 

re Old value of X(2Z) 

KB Vector including XBl, X5Be, velocity of sonotuoy, and 
two zeros used in the six-~state system 

X51 True geographical location of sonobuoy, xy 

KB2 True geographical location of sonobuoy, xX, 

2511 Array of initial sonobuoy positions 

X52] Array of 1olUVial sSonctucy positions 


XNEXT Propagated value of X 


Z Measurement vector 


27 





2ZHAT Estimate of 2 
ZN Normally distributed random number from N(z,R) 


ZU Vector of velocity measurement for drift filter 
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APPENDIX B 
COMPUTER PROGRAM FOR DATA GENERATION 


DATA GENERATION 









Set initial conditions: 


sonobouy position and velocity 
aircraft position and velocity 
aircraft heading 

dele 







Call 
LINE or CURVE 






CURVE 





LINE 





Calculate: 


Phi 
Accel 











Calculate: 


Calculate: 
aircraft position 





aircraft position 


PILE 





Calculate: 


aircratt drift 
sonobouy number 
sonobouy position 
measurements, 2 















Write: 


data into 
storage file 






@) 


Flow chart: data generation program. 


Ee 


Biguse 37. 





GAMMA 


GLOSSARY OF COMPUTER VARIABLES 


DATA GENERATION PROGRAM 


Vector cf aircrait-eacceleretions 
Altitude in nautical miles 
Altitude 

Antenna 

IMitlal aireratt velocity 
Aolitude of -sehuter cycie, AY. 
Amplitude of Schuler cycle, ne 
TRLCTCeDt On NS “axis Of Slrelent track 
SONODUOY CGritt -directior 

Sonobucy RF channel or number 


SOPOUNCY adrift €irection 


Rate of change of nautical miles for a change in 
degrees of longitude 


Leneth of straight track 

Interval between measurements, At 

Relative velocity, Av) 

Relative velocity, Av» 

Relative position, ax, 

Relative position, Ax, 

Total change in heading while on curved track 
seed for the random numter generator 
Indicator of EOF 

uravitational acceleration 


Alrerart- vitcm anecie, 
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HR 
LOuUT 
1OUlP 
LOTR 
LOUTZ 


ITIME 


Pig 


Gamma in radians 

Aircraft heading 

Final heading on curved trac«# 

Time in hours 

Heading in radiadans 

Device on which print is made 

File in which results are written 

File in which true sonobuoy pcsitions are written 
File in which random vectors are insoected 

Time from aircraft clock in seconds 
Rate of linear navigational drift, A 
Rate of linear navigational drift, a 


Latitude 


The latitude of the origin of the local earth fixed 
coordinate system 


Longitude 


The longitude of the origin of the local earth fixed 
ccordinate system 


Array of initial drop times for the sornobucy 

Slope of straight track 

Indicates the first time a buoy is to be proccessed 
Time in minutes 

index 

Total number of sonotuoys 

End of line or curve series 

Aircratt roll angle, p 


T 


iq 


29 





Phi in radians 

Radius of curved track 

Unit vector component of antenna baseline 
Unit vector component of antenna baseline 
Unit vector component of antenna baseline 
Distance aircraft travels in time At 

Time in seconds 


Rate of change of nautical miles for a change in 
degrees of latitude 


Direction of aircraft travel over the szround 
Direction te center cf curved track 

Direction from cenver of curved track to @ircr]art 
VEROCLtUY Of “alreraft 

Vetocity, Of -ailrcrar t 

SOrPoDuUOyY Cdrirtt 

SOnODUCY Griit 

Wind direction 

Wind velocity 

Aircraft inertial position, ce 

AlrCYrazrt true position. A 

True geographical location of sonobuoy, xz 


1 
True geographical location of sonobuoy, x, 
Location of the center of the curved track 
Location of the center of the curved track 
Incremental change in x, 

Incremental change in x, 

Measurement vector 
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Figure 38. RMS errors for two-state system (top) and six- 
State systen (bottom) using circular pattern at 5 NM. 
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Figure 39. RMS errors for two-state system (top) and six- 
state system (bottom) using circular pattern at 30 NM. 
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Figure 40. RMS errors for two-state system (top) and six- 
state system (bottom) using circular pattern at 45 NM. 
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RMS errors for two-state system (top) and six- 
state system (bottom) using square pattern with 
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Figure 42. RMS errors for two-state system (top) and six- 
state system (bottom) using square pattern with +t=10 sec. 


144 





(70S) 


RMS POSITION ERROR 


(10S) 


RMS POSITION ERROR 


; 


| 


| | 
TER: ISQRT ee Gas, 


x |- ABQUT MAN FILTER |POSITION 
a © /- ABGUT ACTUAL POSITION | 





























TAME TRIES: 
2000. 
| | 
| | SOLID - FIUTER: 'SQRT(P1-P2 
| | | | KX j- ABQUT MEAN FILTER POSITION 
” : | | © +- 9BGUT ACTUAL POSITICN 





} 





Figure 43. RMS errors for two-state system (top) and six- 
state system (bottom) using square pattern with +t=30 sec. 
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Figure 43. RMS errors for two-state system (top) and six- 
state system (bottom) using circular pattern, Al1t=300'. 
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Figure 45. RMS errors for two-state system (top) and six- 


state system (bottom) using circular pattern, Alt=10,000'. 


147 





AMS POSITION ERROR <105) 


(YDS) 


ANS POSTITON ERROR 






| 
SOLID |- FILTER: |SQRT IPI+P 
i 


| Xx |- ABQUT MEAN FILTER |POSITION 
© |}- ABOUT actual |Pasttion | | 























1500 l 
| 
1000. 
sad. 
| | 
2 Q 20 uC 50 30 100 120 
TIME (MINUTES) 
2000. ——— 
| | 
| | | | 
| | Ss Oe.(D j= iP ti eee SORT (P1 +P) 
| (lo ie eae. 
| | XX j= ABGUT MBAN FILTER iPOSITION 
| | : ! ©M:- ABOUT ACTUAL POSITISN 
1500. : , a  —  — 
| | 
] | | | 
| | , 
| | | 
| | | i | 
1000. ! enn : : | 
i | ! | 
rr is | oe st SE } 
| a aE l en ag | 
g | | | | | | 
| ! 
500 ® de hiis ! : | ee < o | | | a4 @ | 
, Tk: waa SO fat, 2. ae, get 
x ei aly . + ee ©, & - % 2s 23 97 Pi "0 0 de ee ie Pe: 
H ‘ : Rg z "7 x ‘ gghtg D i = a4 
a ee 
7 Ra's oe | 2 2 
| | | | | 
| { | | t 
} | | 
| i | 
0. ! 
0 20 40 80. a0 00 120 


TIME “MENUTES) 


Figure 46. RMS errors for two-state system (top) and six- 
state system (bottom) using circular pattern, Alt=20,000'. 
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